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Abstract 

This paper reviews modem geometrical dynamics and control of humanoid robots. This gen- 
eral Lagrangian and Hamiltonian formalism starts with a proper definition of humanoid's configu- 
ration manifold, which is a set of all robot's active joint angles. Based on the 'covariant force law', 
the general humanoid's dynamics and control are developed. Autonomous Lagrangian dynamics 
is formulated on the associated 'humanoid velocity phase space', while autonomous Hamiltonian 
dynamics is formulated on the associated 'humanoid momentum phase space'. Neural-like hier- 
archical humanoid control naturally follows this geometrical prescription. This purely rotational 
and autonomous dynamics and control is then generalized into the framework of modern non- 
autonomous biomechanics, defining the Hamiltonian fitness function. The paper concludes with 
several simulation examples. 

Key Words: Humanoid robots, Lagrangian and Hamiltonian formalisms, neural-like humanoid 
control, time-dependent biodynamics 

1 Introduction 

Humanoid robots, being the future of robotic science, are becoming more and more human-like in 
all aspects of their functioning. Both human biodynamics and humanoid robotics are governed by 
Newtonian dynamical laws and reflex-like nonlinear controls |1, 10, 11, 8 2|. 

Although motion of humanoid robots increasingly resembles human motion, we still need to 
emphasize that human joints are (and will probably always remain) significantly more flexible than 
humanoid robot joints. Each joint of a humanoid robot consists of a pair of coupled segments with 
only Eulerian rotational degrees of freedom. Each human synovial joint, on the other hand, not 
only exhibits gross rotational movement (roll, pitch and yaw) but is also capable of exhibiting some 
hidden and restricted translations along (X, Y, Z) axes. For example, in the knee joint, patella (knee 
cap) moves for about 7-10 cm from maximal extension to maximal flexion. It is well-known that 
translational amplitudes in the shoulder joint are even greater. In other words, within the realm of 
rigid body mechanics, a segment of a human arm or leg is not properly represented as a rigid body 
fixed at a certain point, but rather as a rigid body hanging on rope-like ligaments. More generally, 
the whole skeleton mechanically represents a system of flexibly coupled rigid bodies, technically 
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an anthropomorphic topological product of SE(3)-groups. This implies more complex kinematics, 
dynamics and control than in the case of humanoid robots [3]. 

This paper reviews modern geometrical approaches to humanoid robot's dynamics and control. 
It is largely based on authors' own research in closely related fields of human biodynamics, biome- 
chanics and humanoid robotics. This general approach starts with a proper definition of humanoid's 
configuration manifold M, which is a set of all active degrees-of-freedom (DOF). Based on the co- 
variant force law, the general humanoid's dynamics with large number of DOF is developed. The 
tangent bundle of the manifold M (called the velocity phase space) is the stage for autonomous 
Lagrangian formulation of humanoid's dynamics, while the cotangent bundle of the manifold M 
(called the momentum phase space) is the stage for autonomous Hamiltonian formulation of hu- 
manoid's dynamics. This purely rotational and autonomous robot dynamics is then generalized 
along the two main lines of modern non-autonomous biomechanics: (i) more flexible joints, and (ii) 
time-dependent energy function (with energy sources and sinks). 

In contrast to our previously published papers, the present article provides full technical details 
of both autonomous and non-autonomous (time-dependent) biodynamics and robotics, including 
the new neuro-muscular fitness dynamics. This thorough theoretical background would provide an 
interested reader with superb capability to develop their own non-autonomous humanoid simulator. 



2 Configuration Manifold and tlie Covariant Force Law 

Representation of an ideal humanoid-robot motion (with human-like spine, see Figure [U is rigor- 
ously defined in terms of rotational constrained 50(3)-groups of motion 15] |6] |7] HI in all main 
robot joints. Therefore, the configuration manifold M^ob for humanoid dynamics is defined as a 
topological product of all included 50(3) groups, M^ob ~ Hi SO{?>y. 




Figure 1 : Humanoid robot's configuration manifold Mrob, modeled upon human skeleton. Mrob is 
defined as a topological product of constrained rotational 5*0(3) groups, Mrob — Yii 50(3)\ 

Consequently, the natural stage for autonomous Lagrangian dynamics of robot motion is the 
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tangent bundle TMroi^ System's Lagrangian (energy function) is a natural energy function on 
the tangent bundle fSl. Similarly, the natural stage for autonomous Hamiltonian dynamics of robot 
motion is the cotangent bundle T*Mrob- El The Hamiltonian is a natural energy function on the 
tangent bundle |[TOl[niTn. 

More precisely, the three-axial S'0(3)— group of humanoid-robot joint rotations depends on 
three parameters, Euler joint angles = {ip,ip,9), defining the rotations about the Cartesian co- 
ordinate triedar {x, y, z) placed at the joint pivot point. Each of the Euler angles are defined in the 
constrained range (— tt, tt), so the joint group space is a constrained sphere of radius tt |2, 9|. 

Let G = 50(3) = {A G XsxsW : A*- A = h, det(A) = 1} be the group of rotations in R^. 
It is a Lie group and dim(G') = 3. Let us isolate its one-parameter joint subgroups, i.e., consider 
the three operators of the finite joint rotations R^p, R^, Rg G SO{3), given by 
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corresponding respectively to rotations about axis by an angle (ys, about y— axis by an angle i/j, 
and about z— axis by an angle 6. 

The total three-axial joint rotation A is defined as the product of above one-parameter rotations 
R^, Re, i.e., A = R^ ■ R^ ■ Rg is equaH 



A = 



cos Ip COS ip — cos Q sin ip sin V' cos cos ip + cos 9 cos ip sin i/; sin 9 sin il) 
— sin il) cos ip — cos 9 sin sin — sin sin + cos 9 cos ip cos i\) sin 9 cos 
sin 9 sin ip — sin 9 cos ip cos 9 



However, the order of these matrix products matters: different order products give different results. 



'Recall that in multibody mechanics, to each n— dimensional (nD) configuration manifold M there is associated its 2nD 
velocity phase-space manifold, denoted by TM and called the tangent bundle of M. The original smooth manifold M is 
called the base of TM. There is an onto map tt : TM — > M, called the projection. Above each point x a M there is a 
tangent space T^M = ■k~^(x) to M at x, which is called a fibre. The fibre T^M C TM is the subset of TM, such that 
the total tangent bundle, TM = | | TxM, is a disjoint union of tangent spaces TxM to _A/ for all points x g M. From 

mSM 

dynamical perspective, the most important quantity in the tangent bundle concept is the smooth map t) : Af — )■ TM, which 
is an inverse to the projection tt, i.e, tt o v = Idjvf, tt{v(x)) = x. It is called the velocity vector— field. Its graph (x, v{x)) 
represents the cross-section of the tangent bundle TM . This explains the dynamical term velocity phase-space, given to the 
tangent bundle TM of the manifold M . The tangent bundle is where tangent vectors live, and is itself a smooth manifold. 
Vector-fields are cross-sections of the tangent bundle. 

^Recall that in multibody mechanics, a dual notion to the tangent space Tm M to a smooth configuration manifold M 
at a point m is its cotangent space T^M at the same point m. Similarly to the tangent bundle, for a smooth manifold M 
of dimension n, its cotangent bundle T* M is the disjoint union of all its cotangent spaces T^M at all points m € M, 
i.e., T*M = |_J T^M. Therefore, the cotangent bundle of an n-manifold M is the vector bundle T* M = (TM)*, 

the (real) dual of the tangent bundle TM. The cotangent bundle is where 1-forms live, and is itself a smooth manifold. 
Covector-fields (1-forms) are cross-sections of the cotangent bundle. 

^Note that this product is noncommutative, so it really depends on the order of multiplications. 
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as the matrix product is noncommutative product^ This is the reason why Hamihon's quaternion^ 
are today commonly used to parameterize the 50(3)— group, especially in the field of 3D computer 
graphics. 

The autonomous humanoid dynamics (both Lagrangian and Hamiltonian), is based on the postu- 
late of conservation of total mechanical energy. It can be derived from the covariant force law IJIHI' 
which in 'plain English' states: 



Force 1-form — Mass distribution x Acceleration vector-field, 



^The one-parameter rotations R^, R^, Rg define curves in 50(3) starting from 



tives inip = 0,tp = and 9 = belong to tlie associated tangent Lie algebra so (3). That is, the corresponding infinitesimal 
generators of joint rotations - joint angular velocities v^,v^,vg G so (3) - are respectively given by 
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Moreover, the elements are linearly independent and so 
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The Lie algebra so (3) is identified with by associating to each v 
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The exponential map cxp : so{3) 



50 (3) is given by Rodrigues relation 
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where the norm \\v\\ is given by 



||d|| = ^(1,1)2 + (t,2)2 + (t,3)2. 
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the matrix v G so(3) given by 



The the dual, cotangent Lie algebra so (3) * , includes the three joint angular momenta Ptp,p^,pg G so (3) * , derived from 
the joint velocities v by multiplying them with corresponding moments of inertia. 

'Recall that the set of Hamilton's quaternions H represents an extension of the set of complex numbers C. We can 
compute a rotation about the unit vector, u by an angle 6. The quaternion q that computes this rotation is 



cos — , u sin — 
2 2 
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and formally reads (using Einstein's summation convention over repeated indices): 



F, 



ma a-' 



(1) 



Here, the force 1-form Fi = Fi{t,q,p) = Fl{t,q,q), {i — l,...,n) denotes any type of actuator 
torques; rriij is the material (mass-inertia) metric tensor, which gives the total mass distribution 
of the robot (including all segmental masses and their individual inertia tensors); is the total 
acceleration vector-field, including all segmental vector-fields, defined as the absolute (Bianchi) 
derivative -D' of all segmental angular velocities = i*, {i = 1, ...,n), where n is the total number 
of active DOF with local coordinates (x*). 

More formally, this central Law of robotics represents the covariant force functor J> constructed 
over robot's configuration manifold Mrob = M and defined by the following commutative diagram: 



TT*M 



TTM 




(2) 



The right-hand branch of the fundamental covariant force functor J^* : TT*M — !• TTM de- 
picted in (|2]) is Lagrangian dynamics with its Riemannian geometry. To each n— dimensional (nD) 
smooth manifold M there is associated its 2rtD velocity phase-space manifold, denoted by TM and 
called the tangent bundle of AT The original configuration manifold M is called the base of TM. 
There is an onto map tt : TM M, called the projection. Above each point x G M there is a 
tangent space T^M — tt^^{x) to M at x, which is called a fibre. The fibre T^M C TM is the 
subset of TM, such that the total tangent bundle, TM — | | T^M, is a disjoint union of tangent 

meM 

spaces TxM to M for all points x G AT From dynamical perspective, the most important quantity 
in the tangent bundle concept is the smooth map v : M ^ TM, which is an inverse to the projection 
TT, i.e, IT o V ^ Mm, 7t{v{x)) = x. It is called the velocity vector-field v' — i'H Its graph (x, v{x)) 
represents the cross-section of the tangent bundle TAT Velocity vector-fields are cross-sections of 
the tangent bundle. Biomechanical Lagrangian (that is, kinetic minus potential energy) is a natural 
energy function on the tangent bundle TM. The tangent bundle is itself a smooth manifold. It has its 
own tangent bundle, TTAT Cross-sections of the second tangent bundle TTM are the acceleration 
vector- fields. 

The left-hand branch of the fundamental covariant force functor J> : TT*M — > TTM depicted 
in (O is Hamiltonian dynamics with its symplectic geometry. It takes place in the cotangent bundle 
T*Mrob, defined as follows. A dual notion to the tangent space TxM to a smooth manifold M at a 
point X — (x*) with local is its cotangent space T*M at the same point x. Similarly to the tangent 
bundle TM, for any smooth nD manifold M, there is associated its 2nD momentum phase-space 

^This explains the dynamical term velocity phase-space, given to the tangent bundle TM of the manifold M. 
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manifold, denoted by T*M and called the cotangent bundle. T*M is the disjoint union of all its 
cotangent spaces T*M at all points x G M, i.e., T*M = |^ T*M. Therefore, the cotangent 

bundle of an n— manifold M is the vector bundle T*M — (TM)*, the (real) dual of the tangent 
bundle TM. Momentum 1-forms (or, covector-fields) pi are cross-sections of the cotangent bundle. 
Biomechanical Hamiltonian (that is, kinetic plus potential energy) is a natural energy function on 
the cotangent bundle. The cotangent bundle T*M is itself a smooth manifold. It has its own tangent 
bundle, TT*M. Cross-sections of the mixed-second bundle TT*M are the force 1-forms Fi ~ pi. 
There is a unique smooth map from the right-hand branch to the left-hand branch of the diagram 

©: 

TM 3 {x\v') ^ {x\p') e T*M. 

It is called the Legendre transformation, or fiber derivative (for details see, e.g. 191). 

The fundamental covariant force functor : TT*M — > TTM states that the force 1-form 
Fi — Pi, defined on the mixed tangent-cotangent bundle TT*M, causes the acceleration vector- 
field a' — v^, defined on the second tangent bundle TTM of the configuration manifold M. The 
corresponding contravariant acceleration functor is defined as its inverse map, J-* : TTM — > 
TT*M. 



3 Lagrangian vs. Hamiltonian Approach to Humanoid Robotics 

The humanoid's configuration manifold Alrob = M is coordinated by local joint angular coordinates 
a;*(i), i — 1, ...,n — total number of active DOE The corresponding joint angular velocities x'^{t) 
live in the velocity phase space TM (the tangent bundle of the configuration manifold Af)fl which 
has the Riemannian geometry with the local metric form: 

dx^ dx^ 

{g) = ds^ ^ gijdx'^dx' , where = to^^^^ — — 

is the material metric tensor defined by humanoid's mass-inertia matrix (composed of individual 
segmental masses m^) and dx* are differentials of the local joint coordinates on M. Besides 
giving the local distances between the points on the manifold M, the Riemannian metric form {g) 
defines the system's kinetic energy: 

T — —gijX i-* , 

'On the velocity phase-space manifold TM exists: 

1. A unique 1— form Sj,, defined in local coordinates q', i)' = g Uv (Uy open in TM) by = L^idq', where 
L^. = dL/dvK 

2. A unique nondegenerate Lagrangian symplectic 2— form which is closed (dwi^ = 0) and exact (a; ^ = dO^ = 

dL^, Adq^). 

TM is an orientable manifold, admitting the standard volume given by 

iV(iV + l) 



in local coordinates q^, = q' & Uv iUv open in TM) it is given by 

= A ■ ■ ■ A A dt)^ A ■ ■ ■ A di> 
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giving the Lagmngian equations of the conservative skeleton motion with kinetic-minus-potential 
energy Lagrangian L = T — V , with the corresponding geodesic form 1|9J 

—Lj.i - Lj,, = or, equivalently + T\uX^x^ = 0, (3) 

at ■' 

where subscripts denote partial derivatives, while are the Christoffel symbols of the affine Levi- 
Civita connection of the humanoid manifold M, given by 

Hfe ^ S^'r^fci, Fij-fc = -{^^^gjk + d^igki + d^kgij). 

The general form of autonomous Lagrangian humanoid robotics on the corresponding Rieman- 
nian tangent bundles TMrob and TMhum of the configuration manifolds Mrob and Mhum (precisely 
derived in [(8J) can be formulated in a unified form as: 

^Li, - L^, = Fi{t,x,x) , (i = l,...,n), (4) 

where Fi are all possible torque 1 -forms, including robot's actuators, joint dissipations and external 
disturbances. 

On the other hand, we develop the autonomous Hamiltonian robotics on humanoid's configura- 
tion manifold Mrob = M in three steps, following the standard symplectic geometry prescription 
(see mill): 

Step A Find a symplectic momentum phase-space (P, uj). 

Recall that a symplectic structure on a smooth manifold M is a nondegenerate closecH 2— form 
UJ on A/, i.e., for each x G M, ljj{x) is nondegenerate, and duj = 0. 

Let T*M be a cotangent space to M at to. The cotangent bundle T*M represents a union 
\Jm£MT*M , together with the standard topology on T*AI and a natural smooth manifold structure, 
the dimension of which is twice the dimension of A/. A 1— form 9 on M represents a section 
: M T*M of the cotangent bundle T*M. 

P — T*M is our momentum phase-space. On P there is a nondegenerate symplectic 2— form 
u! is defined in local joint coordinates a;*,pi G U, U open in P, as oj — dx^ A dpi. In that case the 

*A p— form /3 on a smooth manifold M is called closed if its exterior derivative d = didx^ is equal to zero, 

dl3 = 0. 

From this condition one can see that the closed form (the kernel of the exteiior deiivative operator d) is conserved quantity. 
Therefore, closed p— forms possess certain invariant properties, physically corresponding to the conservation laws. 
Also, a p— form j3 that is an exterior derivative of some (p — 1)— form a, 

13 = da, 

is called exact (the image of the exterior derivative operator d). By Poincare lemma, exact fornis prove to be closed automat- 
ically, 

dp = d{da) = 0. 

Since d^ = 0, every exact form is closed. The converse is only partially true, by Poincare lemma: every closed form is 
locally exact. 

Technically, this means that given a closed p— form a S ^^{U), defined on an open set [/ of a smooth manifold M any 
point m aU has a neighborhood on which there exists a (p — 1)— form f} 6 Q,^~^{U) such that df) = a|j7. In particular, 
there is a Poincare lemma for contractible manifolds: Any closed form on a smoothly contractible manifold is exact. 
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coordinates G U are called canonical. In a usual procedure the canonical 1— form 9 is first 

defined as 6* = Pidx\ and then the canonical 2-form w is defined as a; = —d9. 
A symplectic phase-space manifold is a pair (P, lj). 

Step B Find a Hamiltonian vector-field Xh on (P, oj). 

Let (P, a;) be a symplectic manifold. A vector-field X : P ^ TP is called Hamiltonian if there 
is a smooth function P : P M such that X\ll! = dP (X\uj = denotes the interior product 
or contraction of the vector-field X and the 2-form uj). X is locally Hamiltonian if Xjw is closed. 

Let the smooth real-valued Hamiltonian function H : P ^ M., representing the total humanoid 
energy H{x,p) — T{p) + V{x) {T and V denote kinetic and potential energy of the system, 
respectively), be given in local canonical coordinates x"^ ,pi G U, U open in P. The Hamiltonian 
vector-field Xh, condition by Xh\uj — dH, is actually defined via symplectic matrix J, in a local 
chart U, as 

Xh = JVH = {dp^ H, -d.,.H), J= (^_°^ , (5) 
where / denotes the n x n identity matrix and V is the gradient operator. 

Step C Find a Hamiltonian phase-fiow (p^ of Xh- 

Let (P, w) be a symplectic phase-space manifold and Xh = JVH a Hamiltonian vector-field 
corresponding to a smooth real-valued Hamiltonian function : P — > M, on it. If a unique one- 
parameter group of diffeomorphisms 0^ : P — > P exists so that ^ |t=o (Pt^ — JyH{x), it is called 
the Hamiltonian phase-fiow. 

A smooth curve t n> Pi{t)^ on {P,uj) represents an integral curve of the Hamiltonian 

vector-field Xh = JVH, if in the local canonical coordinates x'^,pi G U,U open in P, Hamiltonian 
canonical equations hold (with du = d/du, ): 

= dp^H, p, - -d,,H. (6) 

An integral curve is said to be maximal if it is not a restriction of an integral curve defined on 
a larger interval of R. It follows from the standard theorem on the existence and uniqueness of the 
solution of a system of ODEs with smooth rh.s, that if the manifold (P, lu) is Hausdorff, then for 
any point x ~ {x'^,pi) G U, U open in P, there exists a maximal integral curve of Xh = JVH, 
passing for t — {), through point x. In case Xh is complete, i.e., Xh is and (P, w) is compact, 
the maximal integral curve of Xh is the Hamiltonian phase-flow (pf : U ^ U. 

The phase-flow is symplectic if uj is constant along (j)^, i.e., (plu — u 

(4>l(jJ denotes the pull- of (jj by <j)f), 

iff£x„w=0 

(£xff <^ denotes the Lie derivativel^^ of lu upon Xh)- 

'Given a map f ■ X — > X' between the two manifolds, tlie puUback on Jf of a fonn a on X' by / is denoted by f*a. 
The pullback satisfies the relations 

r(a A /?) = /*« A/*/?, df*a = r{da), 

for any two forms a, l3 G SiP{X). 

'"The Lie derivative £uQ: of p— form a along a vector-field u is defined by Caitan's 'magic' formula (see (9]): 

£,uCt = u\da + d{u]a). 
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Symplectic phase-flow (fif consists of canonical transformations on (P, u), i.e., diffeomorphisms 
in canonical coordinates x'^,pi € U, U open on all (P, w) which leave uj invariant. In this case the 
Liouville theorem is valid: (p^ preserves the phase volume on (P, w). Also, the system's total energy 
H is conserved along 0^, i.e., H o (p^ = 0^. 

Recall that the Riemannian metrics g = <, > on the configuration manifold M is a positive- 
definite quadratic form g : TM M, in local coordinates E U, U open in M. Given the 
metrics gij, the system's Hamiltonian function represents a momentum p-dependent quadratic form 
H : T*M ^ R - the system's kinetic energy H{p) = T{p) = ^ < p,p >, in local canonical 
coordinates x\pi G Up, Up open in T*M, given by 

H{p) ^]^g''{x,m)p,pj, (7) 

where g^-'{x, m) = g^j^{x, m) denotes the inverse (contravariant) material metric tensor 

T*M is an orientable manifold, admitting the standard volume form 

I ' 

w 



^''^H - ^71 I^H- 



For Hamiltonian vector-field, Xh on M, there is a base integral curve 7o(i) — Pi(t)) 
iff 7o(i) is a geodesic, given by the one-form /orce equation 

p,=p,+T)^g^'g''"'pip,r,^0, with i*'' = /V.- (8) 

The l.h.s Pi of the covariant momentum equation dHJ represents the intrinsic or Bianchi covariant 
derivative of the momentum with respect to time t. Basic relation pi = defines the parallel 
transport on , the simplest form of humanoid's dynamics. In that case Hamiltonian vector-field 
Xh is called the geodesic spray and its phase-flow is called the geodesic flow. 

For Earthly dynamics in the gravitational potential field V : M -> R, the Hamiltonian H : 
T*M extends into potential form 

H{p,x) = ^g'^p,pj+V{x), 

with Hamiltonian vector-field Xh = JVH still defined by canonical equations (|6]l. 



It satisfies the Leibnitz relation 

S.u{a A /3) = £„a A ^ + « A £„/3. 

Here, the contraction J of a vector-field u = u^^df_i and a p— form a = a^-^ x^dx-^^ A - ■ ■ Adx^p on a humanoid manifold 
X is given in local coordinates on X by 

u\a = u'^a^Xi.-Xj.-idx^^ A ■ ■ ■ A dx^p-K 

It satisfies the following relation 

Mj(aA/3) = MjaA/3-|-(-l)l"laAuJ/3. 
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A general form of a driven, non-conservative Hamiltonian equations reads: 

x'^dp^H, p,=F,-d,.H, (9) 

where Fi — Fi{t,x,p) represent any kind of joint-driving covariant torques, including active neuro- 
muscular-Uke controls, as functions of time, angles and momenta, as well as passive dissipative and 
elastic joint torques. In the covariant momentum formulation the non-conservative Hamiltonian 
equations ^ become 

p^=p^ + rjfe g^'g''" pipn, = Fi with x^ = g'^'p^ . 

The general form of autonomous Hamiltonian robotics is given by dissipative, driven Hamilto- 
nian equations on T*M: 

= dp^H + dp^R, (10) 
P^ = F,~d^^H + d^^R, (11) 
x\0) = xl P^(0)=P°, (12) 

including contravariant equation (llOb - the velocity vector-field, and covariant equation (II lb - the 
fijrce 1-form (field), together with initial joint angles and momenta ( fTSl i. Here R = R{x,p) denotes 
the Raileigh nonlinear (biquadratic) dissipation function, and Fi = Fi{t, x,p) are covariant driving 
torques of robot's actuators. The velocity vector-field (ITOl i and the force 1 —form ( fTTb together define 
the generalized Hamiltonian vector-field Xh', the Hamiltonian energy function H = H{x,p) is its 
generating function. 

As a Lie group, the humanoid's configuration manifold M ~ Yij SO(3y is Hausdorff^ There- 
fore, for X = (x% Pi) e Up, where Up is an open coordinate chart in T*M, there exists a unique 
one-parameter group of diffeomorphisms (j)^ : T*M — > T*M, that is the autonomous Hamiltonian 
phase-flow: 

: T*M ^T*M :{p{0),xiO))^{p{t),x{t)), (13) 
(0t ° (t^s = (t't+s, = identity), 

given by (fTOHTSl i such that 

— \t=Q (j)tx = J'VH{x). 

The general form of Hamiltonian humanoid robotics on the symplectic cotangent bundle T*Mrob 
of the configuration manifold M^ob (as derived in IfTTl [3] lU) is based on the affine Hamiltonian 
function : T* M M, in local canonical coordinates on T*M given by 

Ha{x,p,u) ^ Ho{x,p) - W{x,p)uj, (14) 

where Ho{x,p) is the physical Hamiltonian (kinetic + potential energy) dependent on joint coordi- 
nates and canonical momenta p*, = {x,p), (j = 1, . . . , m < n are the coupling Hamilto- 
nians corresponding to the system's active joints and Ui = Ui{t, x,p) are (reflex) feedback-controls. 

"That is, for every pair of points xi,X2 € M, there are disjoint open subsets (charts) Ui,U2 C M such that xi € J7i 
and X2 e U2. 
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Using (fMb we come to the affine Hamiltonian control HBE-system, in deterministic form 

= dp^ Ho - dp^ W U.J + dp^ R, (15) 

(i = l,...,n; j = 1,..., M <n), 

(Ti = Ti{t, x,p), Hq = Hq{x,p), — {x,p), Ha = Ha{x,p, u), R =: R{x,p)), as well as in 
the fuzzy-stochastic form 

dq' = idp.Hoia^j) - dp.H^{(j^) uj + dp^R) dt, 

dpi = Bij[x'{t),t]dW^{t) + (16) 

{Ti{t,x,p) - d^,Ho{(T^) + d^.H^{<T^)uj +d^,R) dt, 
do' = -duMa^) dt = W{a^) dt, 

In (fT5])-(fT6ll, R — R{x,p) denotes the joint (nonlinear) dissipation function, o* are affine system 
outputs (which can be different from joint coordinates); {cr}^ (with /i > 1) denote fuzzy sets of 
conservative parameters (segment lengths, masses and moments of inertia), dissipative joint damp- 
ings and actuator parameters (amplitudes and frequencies), while the bar (.) over a variable denotes 
the corresponding fuzzified variable; Bij[q'^{t),t] denote diffusion fluctuations and W^{t) are dis- 
continuous jumps as the rt-dimensional Wiener process. 

4 Generalization to Human Biodynamics 

If we neglect anatomy and physiology of human sensors and effectors, that is, from purely mechan- 
ical perspective, there are two main dynamical differences between robots and humans: (i) human 
joints are more flexible than robot joints (effectively many more degrees-of-freedom), and (ii) hu- 
man dynamics is usually non-autonomous, or time-dependent. We will explain both differences in 
some detail in the following subsections. 

4.1 Realistic Configuration Manifold of Human Motion 

Every rotation in all synovial human joints is followed by the corresponding micro-translation, 
which occurs after the rotational amplitude is reached ||3]- So, representation of human motion 
is rigorously defined in terms of Euclidean S'i?(3)-groups of full rigid-body motion [TT, '51 in all 
main human joints (see Figure|2]l. Therefore, the configuration manifold Mhum for human dynamics 
is defined as a topological product of all included constrained SE{3) groups, Mhum — Yii SE{3y. 
Consequently, the natural stage for autonomous Lagrangian dynamics of human motion is the tan- 
gent bundle TMhum ISJ, and for the corresponding autonomous Hamiltonian dynamics is the cotan- 
gent bundle T*Mhum QOlIIlini. 
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S£(3) S£(3) 



Figure 2: The configuration manifold Mhum of the human body is defined as a topological product 
of constrained SE{3) groups acting in all major (synovial) human joints, Mhum — Yii SE{3) ''. 



Briefly, the Euclidean SE(3)-group is defined as a semidirect (noncommutative) product of 3D 
rotations and 3D translations, SE{3) :— SO{3) [> M.^. Its most important subgroups are the follow- 
ing [?,[l2lia): 



Subgroup 



Definition 



S0{3), group of rotations 
in 3D (a spherical joint) 



Set of all proper orthogonal 
3 X 3 — rotational matrices 



SE{2), special Euclidean group 
in 2D (all planar motions) 



Set of all 3 X 3 — matrices: 

cos 9 sin 6 Tx 
— sin 6 cos 9 ry 
1 



S0{2), group of rotations in 2D 
subgroup of 5i?(2)-group 
(a revolute joint) 



Set of all proper orthogonal 
2 X 2 — rotational matrices 
included in SE{2) — group 



, group of translations in 3D 
(all spatial displacements) 



Euclidean 3D vector space 



4.2 Time-Dependent Biodynamics 

Recall that in ordinary autonomous mechanics we have a configuration manifold M (which denotes 
both Mrob and Mhum), coordinated by (x*), and the corresponding velocity phase-space mani- 
fold is its tangent bundle TM, coordinated by (x*, i'). However, in modern geometrical settings 
of non-autonomous mechanics, the configuration manifold of time-dependent mechanics is a fi- 
bre bundle tt : A/ — ^ M, called the configuration bundle, coordinated by (t, x'), where t G M is 



12 



a Cartesian coordinate on the time axis R with the transition functions t' = i+const. The corre- 
sponding velocity phase-space is the 1-jet space J^(M, M), which admits the adapted coordinates 
{t, xj) = {t, a;% i*). Every dynamical equation ^ defines a connection on the affine jet bundle 
Ji(R, M) M, and vice versa [9J. 

Given the configuration fibre bundle M — ;> R over the time axis R, we say that the 1 —jet manifold 
J^(R, M) is defined as the set of equivalence classes jls of sections : M ^ M of the bundle 
M — > M, which are identified by their values [t], as well as by the values of their partial derivatives 
dts^ = dts^{t) at time points t £ M. The 1-jet manifold J^(M, M) is coordinated by [t, , i'), so 
the 1-jets are local coordinate maps 

jls : R ^ M, {t,x\x'). 

Similarly, the 2~jet manifold (M, M) is the set of equivalence classes jfs of sections s* : M — > M 
of the configuration bundle tt : A/ — > M, which are identified by their values s*(i), as well as the 
values of their first and second partial derivatives, dts^ — dts^{t) and dus^ = dtts'^{t), respectively, 
at time points t e R. The 2-jet manifold J^(R,A/)is coordinated by (t, x% i*, x*), so the 2-jets are 
local coordinate maps 

jfs : R M, i h-> {t,x\x\x''). 

Given the configuration bundle M — > R, coordinated by {t, a;'), and its 2-jet space J^(R, M), 
coordinated by {t, a;*, xl, xl^), any dynamical equation ^ on the configuration bundle M — )■ R, which 
generalizes Lagrangian equation (|4|i, 

^ xl,^e{t,x\x^ (17) 

is equivalent to the geodesic equation with respect to some affine connection F on the tangent bundle 

TM M, 

which fulfills the conditions 

r°-o, c = n + 4^\i=i,i^=.i- (18) 

A holonomic connection ^ is represented by the horizontal vector-field on (R, M), 

^^dt+xld,+e{x'',xl)dl (19) 

A dynamical equation ^ is said to be conservative if there exists a trivialization A/ ^ R x M such 
that the vector-field ^ (O on (R, Af) 9:^ M x TM is projectable onto TM. Then this projection 

E^=x'd,+e{x^,±')di 

is a second-order dynamical equation on a typical fibre M of Af -> R, 

F=S^. (20) 

Conversely, every second-order dynamical equation S ( l20l i on a manifold M can be seen as a con- 
servative dynamical equation 

£,s = dt + i'di + 
on the trivial fibre bundle R x A4^ ^ R. 
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4.2.1 Nonautonomous Dissipative Hamiltonian Dynamics 

We can now formulate the time-dependent biomechanics lfT3l [T4l [151 in which the biomechanical 
phase space is the Legendre manifolc0 11, endowed with the holonomic coordinates (t, y\pi) with 
the transition functions 

n admits the canonical form A given by 

A ^ dpi A dy' A dt®dt. 

We say that a connection 

7 = (a* + ya, + 7,90 

on the bundle 11 AT is locally Hamiltonian if the exterior form 7J A is closed and Hamiltonian if 
the form 7J A is exact IfTSl . A connection 7 is locally Hamiltonian iff it obeys the conditions: 

- d'f = 0, .9,7, - dj-i, = 0, djf + d'-ij = 0. 

Note that every connection T = dt ® {dt + T^di) on the bundle Y — > X gives rise to the 
Hamiltonian connection F on 11 — > X, given by 

f = dt®{dt + rd,-djrp,d'). 

The corresponding Hamiltonian form Hy is given by 

Ht ^ Pidy^ -piVdt. 
Let be a dissipative Hamiltonian form on 11, which reads: 

H = pidy' - Hdt ^ pidy' - piT'dt - Hrdt. (21) 

We call H and in the decomposition ( 1211 1 the Hamiltonian and the Hamiltonian function respec- 
tively. Let 7 be a Hamiltonian connection on 11 — > X associated with the Hamiltonian form ( 1211 1. It 
satisfies the relations IIT6I 

7J A = dpt A dy' + 7,0??/* A dt - j^dpi Adt = dH, 

f = d'U, 7,; = -d,H- (22) 

From equations (l22T l we see that, in the case of biomechanics, one and only one Hamiltonian con- 
nection is associated with a given Hamiltonian form. 

Every connection 7 on 11 — > X yields the system of first-order differential equations: 

y'^l\ P^^l^■ (23) 

They are called the evolution equations. If 7 is a Hamiltonian connection associated with the Hamil- 
tonian form H (I21I 1. the evolution equations ( l23T l become the dissipative time-dependent Hamilto- 
nian equations: 

if = d'n, p, = ~d,n. (24) 

'^The maximum dimensional integral manifold of a certain diffeomorphism group is called the Legendre manifold. 
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In addition, given any scalar function / on 11, we have the dissipative Hamiltonian evolution 
equation 

dnf^ {dt + d^m, - dm') /, (25) 

relative to the Hamiltonian %. On solutions s of the Hamiltonian equations (l24b . the evolution 
equation dZSl l is equal to the total time derivative of the function /: 

4.2.2 Neuro-Muscular Fitness Dynamics 

The dissipative Hamiltonian system (I24l)-(l25b is the basis for our time & fitness-dependent biome- 
chanics. The scalar function / in dZST l on the biomechanical Legendre phase-space manifold 11 is 
now interpreted as an individual neuro-muscular fitness function. This fitness function is a 'determi- 
nant' for the performance of muscular drives for the driven, dissipative Hamiltonian biomechanics. 
These muscular drives, for all active DOF, are given by time & fitness-dependent Pfaffian form: 
Fi = Fi {t, y, p, /). In this way, we obtain our final model for time & fitness-dependent Hamiltonian 
biomechanics: 

y' = 

pi = Fi - diH, 
dnf = {dt + d'm,-d{Hd')f. 

Physiologically, the active muscular drives Fi = Fi{t, y,p, f) consist of |l2]): 

1. Synovial joint mechanics, giving the first stabilizing effect to the conservative skeleton 
dynamics, is described by the (y , ?/)-form of the Rayleigh-Van der Pol 's dissipation function 

1 " 

i=l 

where ai and /3j denote dissipation parameters. Its partial derivatives give rise to the viscous- 
damping torques and forces in the joints 

which are hnear in and quadratic in . 

2. Muscular mechanics, giving the driving torques and forces J"™"'"= = T^"^'^{t,y,y) with 
{i = 1, . . . ,n) for human biomechanics, describes the internal excitation and contraction dynamics 
of equivalent muscular actuators 121 . 
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(a) The excitation dynamics can be described by an impulse force-time relation 

p^n.p ^ ^0(^ „ g-t/r,) if stimulation > 
p^mp ^ i^Og-tM if Stimulation =0, 

where denote the maximal isometric muscular torques and forces, while Tj denote the associ- 
ated time characteristics of particular muscular actuators. This relation represents a solution of the 
Wilkie's muscular active-state element equation tl7|| 

li + V^i = TSA, /^(O) = 0, 0<S'<1, 

where /i = represents the active state of the muscle, F denotes the element gain, A corresponds 
to the maximum tension the element can develop, and S = S{r) is the 'desired' active state as a 
function of the motor unit stimulus rate r. This is the basis forbiomechanical force controller 

(b) The contraction dynamics has classically been described by Hill's hyperbolic force-velocity 
relation HH 

pHui ^ (^"^» - ^^j'^^y' ) 

{5^,V' + bi) ' 

where and hi denote Hill's parameters, corresponding to the energy dissipated during the con- 
traction and the phosphagenic energy conversion rate, respectively, while 5ij is the Kronecker's 
5— tensor. 

In this way, human biomechanics describes the excitation/contraction dynamics for the ith equiv- 
alent muscle-joint actuator, using the simple impulse-hyperbolic product relation 

5 Hierarchical Control of Humanoid Robots 
5.1 Spinal Control Level 

The /orce HBE servo-controller is formulated as affine control Hamiltonian-sy stems (fTSl - ITSI l (with 
possible extensions along the lines of the previous section), which resemble an autogenetic motor 
servo II20I . acting on the spinal-reflex level of the human locomotion control. A voluntary con- 
traction force F of human skeletal muscle is reflexly excited (positive feedback by the re- 
sponses of its spindle receptors to stretch and is reflexly inhibited (negative feedback — by the 
responses of its Golgi tendon organs to contraction. Stretch and unloading reflexes are mediated 
by combined actions of several autogenetic neural pathways, forming the so-called 'motor servo.' 
The term 'autogenetic' means that the stimulus excites receptors located in the same muscle that is 
the target of the reflex response. The most important of these muscle receptors are the primary and 
secondary endings in the muscle-spindles, which are sensitive to length change - positive length 
feedback -\-F^^, and the Golgi tendon organs, which are sensitive to contractile force - negative 
force feedback — i^^^. 

The gain G of the length feedback +F^^ can be expressed as the positional stiffness (the ra- 
tio G w 5 = dF/ dx of the force-F change to the length-x change) of the muscle system. The 
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greater the stiffness S, the less the muscle will be disturbed by a change in load. The autoge- 
netic circuits +F^^ and —F^^ appear to function as servoregulatory loops that convey continu- 
ously graded amounts of excitation and inhibition to the large (alpha) skeletomotor neurons. Small 
(gamma) fusimotor neurons innervate the contractile poles of muscle spindles and function to mod- 
ulate spindle-receptor discharge. 



5.2 Cerebellum-Like Velocity and Jerk Control 

Nonlinear velocity and jerk (time derivative of acceleration) servo-controllers ||2], developed us- 
ing the Lie-derivative formalism [T|, resemble self-stabilizing and adaptive tracking action of the 
cerebellum [21 1. By introducing the vector-fields / and g, given respectively by 

/ = {dpM,, -d,.Ho) , g = {-dp,W, d,.W) , 

we obtain the affine controller in the standard nonlinear MIMO-system form (see fOj) 

Xi ^ f{x) + g{x)uj. (26) 

Finally, using the Lie derivative formalism ||9]F^ and applying the constant relative degree r to 
all HB joints, the control law for asymptotic tracking of the reference outputs oj^ = o^(^) could be 
formulated as (generalized from ||221 ) 



o 



R 



(27) 



where Cs_i are the coefficients of the Unear differential equation of order r for the error function 

e{t) = x={t)~o'^{t) 

+ c^-ie('-i) + • • • + cie(i) + coe = 0. 

The control law (|27] | can be implemented symbolically in Mathematical in the following 
three steps: 



"Let F{M) denote the set of all smooth (i.e., C°°) real valued functions / ; Af — > M on a smooth manifold M, V{M) - 
the set of all smooth vector-fields on M, and V (M) - the set of all differential one-forms on M. Also, let the vector-field 
f G V(M) be given with its local flow (p^. : M ^ M such that at a point x G M, ^ |j=o 't't^ = C(^)' ™d <j>t representing 
the pull-back by 0^. The Lie derivative differential operator Cq is defined: 

(i) on a function / £ F{M) as 



Cc : F(M) F(M), £<;/ = Jt^'^'t f)\^-0, 



(ii) on a vector-field rj G V(M) as 



: V(M) ^ V(M), Ccr, = -{rtV)\t^O = K,v] 

- the Lie bracket, and 

(iii) on a one-form a £ V* (M) as 

: V*{M) ^ V*{M), C^a = A(</,*a)|t^o. 

In general, for any smooth tensor field T on A/, the Lie derivative CqT geometrically represents a directional derivative of 
T along the flow (hf . 
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1. Symbolic functions defining the gradient and Lie derivatives^ 

Grad[s., xXist] : = (^[s, #l]&)/@x; 

LieDer[t)Xist, s_, a;_List] : = Grad[s, a;] • w; 

KLieDer[t;_List, s_, a;_List, : = 

Block[{i},p : — s; lf[k =— 0,p = s,Do[p = LieDer[v,p,x],{k}]];p]; 

2. Control law defined (for simplicity, we show here only the first-order control law): 

u[t.] = (-LieDer[i^, y, X] + D[yR[tit] + a{yR[t] - 2/))/LieDer[g, y, X]; 

3. Example for the reference output yR[t], with the final time Tfin: 

yUm = lf[t Tfin/2, 5(1 - e"^*), (5(1 - e-5*))/e(^(*-™"/^))]; 

The affine nonlinear MIMO control system (|26] | with the Lie-derivative control law (|27] | resem- 
bles the self-stabilizing and synergistic output tracking action of the human cerebellum [24 1. To 
make it adaptive (and thus more realistic), instead of the 'rigid' controller (|27| |. we can use the adap- 
tive Lie-derivative controller, as explained in the seminal paper on geometrical nonlinear control 

ma. 

5.3 Cortical-Like Fuzzy-Topological Control 

For the purpose of our cortical control, the dominant, rotational part of the human configuration man- 
ifold , could be first, reduced to an A^-torus, and second, transformed to an A^-cube ('hyper- 
joystick'), using the following topological techniques (see [91)0 

Let denote the constrained unit circle in the complex plane, which is an Abelian Lie group. 
Firstly, we propose two reduction homeomorphisms, using the Cartesian product of the constrained 
5'0(2)-groups: 

SO{3) « S0{2) X SO{2) X SO{2) and SO{2) w 5*^ 

Next, let be the unit cube [0, 1]^ in and '^' an equivalence relation on M.^ obtained 
by 'gluing' together the opposite sides of , preserving their orientation. Therefore, can be 
represented as the quotient space of by the space of the integral lattice points in R^, that is an 
oriented and constrained A^-dimensional torus T^: 

N 

R^/Z^ ~ n -^^^ = « = 1> • • • . ^) : mod27r} = . (28) 

1=1 

Its Euler-Poincare characteristic is (by the De Rham theorem) both for the configuration manifold 
and its momentum phase-space T*T^ given by (see ||9l) 

N 

X(T^,T*T^) = E(-1)''^' 
p=i 

'''This is tlie code in Mathematical version 7. 

"Tliis top control level lias not yet been implemented. The main reason for this is its high dimensionality. For example, 
the Human Biodynamics Engine simulator has 270 degrees of freedom (both rotational and translational). Its rotational part 
includes 135 individual Lie-derivative controllers. The integration of so many individual controllers is a nontrivial problem 
that is cun'ently beyond the capacity of pure fuzzy control. 
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where bp are the Betti numbers defined as 

b" = l, 

b'=N,...bP^ (^^^,...6^-1= TV, 

6^ = 1, {0<P<N). 

Conversely by 'ungluing' the configuration space we obtain the primary unit cube. Let '^*' 
denote an equivalent decomposition or 'ungluing' relation. According to Tychonoff's product- 
topology theorem [9|, for every such quotient space there exists a 'selector' such that their quotient 
models are homeomorphic, that is, / r^*^ / ^* . Therefore represents a 'selector' for the 
configuration torus and can be used as an A^-directional 'g-command-space' for the feedback 
control (FC). Any subset of degrees of freedom on the configuration torus representing the joints 
included in HB has its simple, rectangular image in the rectified q-command space - selector , 
and any joint angle has its rectified image q*. 

In the case of an end-effector, reduces to the position vector in external-Cartesian coordinates 

[r = 1, . . . , 3). If orientation of the end-effector can be neglected, this gives a topological 
solution to the standard inverse kinematics problem. 

Analogously, all momenta pi have their images as rectified momenta pi in the p-command space 
- selector . Therefore, the total momentum phase-space manifold T*T^ obtains its 'cortical 

image' as the (q,p)-command space, a trivial 2A^-dimensional bundle x . 

Now, the simplest way to perform the feedback FC on the cortical (g,p)-command space x 
, and also to mimic the cortical-like behavior, is to use the 27V- dimensional fuzzy-logic con- 
troller, in much the same way as in the popular 'inverted pendulum' examples (see [19]). 

Vvfe propose the fuzzy feedback-control map S that maps all the rectified joint angles and mo- 
menta into the feedback-control one-forms 

^■.{q\t),f>,{t))^uS,q,p), (29) 

so that their corresponding universes of discourse, = {qmax ~ Qmin)' Pi ~ {pT""^ ~ p™*") '^^'^ 
Ui = (u™°^ — u™*"), respectively, are mapped as 

N N N 

^■.\{Q' ^\{P^^\{U^. (30) 



The 2 A^-dimensional map S (|29l30t represents a fuzzy inference system, defined by Il24l : 

1 . Fuzzification of the crisp rectified and discretized angles, momenta and controls using Gaussian- 
bell membership functions 

/i,(x)-cxph^^^^^], (fc = l,2,...,9), 

where x £ ^ is the common symbol for g*, pi and Ui{q,p) and D is the common symbol for 
Q', Pi and f, the mean values nik of the nine partitions of each universe of discourse D are de- 
fined as mfc = Afc-D + Xmin^ with partition coefficients Xk uniformly spanning the range of D, 
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Figure 3: The HBE simulating a jump-kick: a 3D viewer. 

corresponding to the set of nine linguistic variables L = {NL, NB, NM, NS, ZE, PS, PM, 
PB, PL}; standard deviations are kept constant crfe = D/9. Using the linguistic vector L, 
the 9x9 FAM (fuzzy associative memory) matrix (a 'linguistic phase-plane'), is heuristically 
defined for each human joint, in a symmetrical weighted form 

^if,i = TAJki exp{-50[Xk + u{q,p)]'^}, (k,l = 1,...,9) 

with weights wki e {0.6, 0.6, 0.7, 0.7, 0.8, 0.8, 0.9, 0.9, 1.0}. 

2. Mamdani inference is used on each FAM-matrix /ij.; for all human joints: 

(i) /i((7*) and are combined inside the fuzzy IF-THEN rules using AND (Intersection, 
or Minimum) operator, 

f^klMl^P)] = min{Aifc;(f ), fJ-kiiPi)}- 

(ii) the output sets from different IF-THEN rules are then combined using OR (Union, or 
Maximum) operator, to get the final output, fuzzy-covariant torques, 

H[u^{q,p)] = max{^fc[uj(q,p)]}. 

k 
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3. Defuzzification of the fuzzy controls ^[ui{q,p)] with the 'center of gravity' method 

J dui 

to update the crisp feedback-control one-forms Ui — Ui{t, q, p). 




1 2 

Time [s] 



Figure 4: The HBE simulating a jump-kick: calculating joint angles and muscular torques. 

Now, it is easy to make this top-level controller adaptive, simply by weighting both the above 
fuzzy-rules and membership functions, by the use of any standard competitive neural-network (see, 
e.g., (T9\). Operationally, the construction of the cortical ((7,p)-command space x and the 
2A^-dimensional feedback map S (129130b . mimic the regulation of the motor conditioned reflexes 
by the motor cortex ||2Tl . 

It has been implicitly assumed that close resemblance of hierarchical control structures presented 
in this section with the corresponding human neuro-physiological control mechanisms would assure 
the necessary overall stability of biodynamics. However, in future work, these control structures 
need to be properly analyzed, starting with Lyapunov stability criteria. 
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Figure 5: The HBE simulating the frontal road- vehicle crash into the fixed wall with a speed of 70 
km/h: before the impact (up) and 0.12 s after the impact. 

6 Simulation Examples 

In this section we give several simulation examples of the sophisticated virtual humanoid called Hu- 
man Biodynamics Engine (HBE), designed at Defence Science & Technology Organisation, Aus- 
tralia. The HBE is a sophisticated human neuro-musculo-skeletal dynamics simulator, based on 
generalized Lagrangian and Hamiltonian mechanics and Lie-derivative nonlinear control. It includes 
270 active degrees of freedom (DOF), while fingers are not separately modelled: 135 rotational DOF 
are considered active, and 135 translational DOF are considered passive. The HBE incorporates 
both forward and inverse dynamics, as well as two neural-like control levels. Active rotational joint 
dynamics is driven by 270 nonlinear muscular actuators, each with its own excitation-contraction 
dynamics (following traditional Hill-Hatze biomechanical models). Passive translational joint dy- 
namics models visco-elastic properties of inter-vertebral discs, joint tendons and muscular ligaments 
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as a nonlinear spring-damper system. The lower neural control level resembles spinal-reflex posi- 
tive and negative force feedbacks, resembling stretch and Golgi reflexes, respectively. The higher 
neural control level mimics cerebellum postural stabilization and velocity target-tracking control. 
The HBE's core is the full spine simulator, considering human spine as a chain of 26 flexibly- 
coupled rigid bodies (formally, the product of 26 SE(3)-groups). The HBE includes over 3000 body 
parameters, all derived from individual user data, using standard biomechanical tables. The HBE 
incorporates a new theory of soft neuro-musculo-skeletal injuries, based on the concept of the local 
rotational and translational jolts, which are the time rates of change of the total forces and torques 
localized in each joint at a particular time instant. 




Figure 6: The HBE simulating an effect of an aircraft pilot-seat ejection to human spine compression: 
before the seat ejection (left) and after ejection (right). 

The first version of the HBE simulator had the full human-like skeleton, driven by the gener- 
alized Hamiltonian dynamics (including muscular force-velocity and force-time curves) and two 
levels of reflex-like motor control (simulated using the Lie derivative formalism) [ ljl2|. It had 135 
purely rotational DOE, strictly following Figure [T] It was created for prediction and prevention 
of musculo-skeletal injuries occurring in the joints, mostly spinal (intervertebral). Its performance 
looked kinematically realistic, while it was not possible to validate the driving torques. It included 
a small library of target movements which were followed by the HBE's Lie-derivative controllers 
with efficiency of about 90% (see Figures |3] and |4]i. 

The HBE also includes a generic crash simulator, based on the simplified road-vehicle impact 
simulator (see Figure|5]l. While implementing the generic crash simulator, it became clear that purely 
rotational joint dynamics would not be sufficient for the realistic prediction of musculo-skeletal 
injuries. In particular, to simulate the action of a Russian aircraft ejection-seat currently used by the 
American space shuttle, we needed to implement micro translations in the intervertebral joints (see 
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Figure 7: The HBE calculating translational forces distributed along the spinal joints during the seat 
ejection. 



Figures|6]and|2ll. This is because the seat provides full body restraint and hence the ejection rockets 
firing with 15 g per .15 s cause pure compression of the spine (without any bending). 

Finally, the HBE includes the defence-specific land-mine crash simulator. It is calibrated on a 
hypothetical double-impact under the armor-protected military vehicle, including: 

1 . A land-mine blast of 350g with a duration of 5ms; 

2. A Is pause when the hypothetical vehicle is in the air; and 

3. The vehicle hard landing with an acceleration of lOOg and a duration Is. 

The HBE calculates full rotational and translational dynamics caused by the land-mine double- 
impact in extreme force/time scales (including both linear and angular displacements, velocities, 
forces and jolts in all human joints (see Figure |8)). The variations of the applied g-forces and dura- 
tions of the two impacts can be simulated, to see the differences in their effects on the hypothetical 
passenger's body. 

In this way a full rotational + translational biodynamics simulator has been created with 270 DOE 
in total (not representing separate fingers). The 'HBE-simulator' has been kinematically validated 
(see Figure in against the standard biomechanical gait-analysis system 'Vicon' ['25'|. 
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Figure 8: The HBE simulating a double-impact effect of a land-mine blast under an armor-protected 
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